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Abstract: 

In  this  paper,  a  new  dynamic  model  for  continuum  robot  manipulators  is  derived.  The  dynamic 
model  is  developed  based  on  the  geometric  model  of  extensible  continuum  robot  manipulators  with 
no  torsional  effects.  The  development  presented  in  this  paper  is  an  extension  of  the  dynamic  model 
proposed  in  [19]  (by  Mochiyama  and  Suzuki)  to  include  a  class  of  extensible  continuum  robot 
manipulators.  Numerical  simulation  results  are  presented  for  a  planar  3-link  extensible  continuum 
robot  manipulator. 

1  Introduction 

In  most  engineered  systems,  the  behaviour  of  the  system  is  required  to  be  accurately  modelled  to 
improve  the  performance  of  the  system.  In  many  applications,  design  simulation  and  proposed 
control  algorithms  require  more  than  just  a  simple  kinematic  or  dynamic  model  [2],  Not  only 
an  accurate  model  but  a  real-time  calculation  of  the  dynamic  model  is  also  needed  for  control 
algorithms  or  simulations. 

The  desire  to  enhance  the  performance  of  robot  manipulators  resulted  in  a  renewed  interest  in 
continuum  robots  [22] .  To  our  best  knowledge,  the  concept  of  continuum  robot  was  first  introduced 
in  the  1960’s  [1].  Numerous  designs  of  continuum  robots  were  presented  in  [4],  [6],  [9],  [12],  and 
[15].  Recently,  there  has  been  an  increasing  interest  in  designing  ‘biologically  inspired’  continuum 
robots.  Some  of  these  designs  are  mimicking  trunks  [8],  [25],  tentacles  [17],  [21],  [24]  and  snakes  [9]. 
Several  commercial  implementations  have  appeared  (i.e.,  [3]  and  [10]). 

The  results  in  this  paper  are  motivated  by  and  are  applicable  to  the  OCTARM  continuum  ma¬ 
nipulator.  The  OCTARM  manipulator  is  a  biologically  inspired  soft  robot  manipulator  resembling 
an  elephant  trunk  or  an  octopus  arm  [18].  The  OCTARM,  shown  in  Figure  1,  is  a  three-section 
robot  with  nine  degrees  of  freedom.  Aside  from  two  axis  bending  with  constant  curvature,  each 
section  is  also  capable  of  extension.  The  bending  and  extension  capabilities  of  OCTARM  makes 
it  suitable  for  a  wide  variety  of  physical  applications  ranging  from  whole  arm  grasping  of  vari¬ 
ous  shapes  of  payloads  to  navigation  of  unstructured  environments  [17]  and  provides  an  increased 
workspace  compared  to  its  inextensible  counterparts  [26].  In  [13],  Jones  and  Walker  presented  a 
kinematic  model  for  a  general  class  of  continuum  robots.  While  the  kinematic  model  proposed  in 
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Honda  Corporation  Grant,  and  by  the  Defense  Advanced  Research  Projects  Agency  (DARPA),  Contract  Number 
N66001-C-8043. 
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[13]  is  applicable  to  OCTARM,  none  of  the  dynamic  models  proposed  in  current  literature  meets 
the  demands.  The  modelling  of  dynamic  behaviour  of  extensible  (variable  length)  continuum  robot 
manipulators  is  an  important  open  research  area. 

There  has  been  some  previous  research  in  dynamic  modelling  of  biologically  inspired  robot 
manipulators.  In  two  recent  papers  [14],  [16],  the  authors  presented  dynamic  models  for  snake- like 
robots.  However,  in  both  cases,  hyper-redundant  serial  rigid-link  systems  are  considered.  This 
does  not  model  the  continuous  nature  of  continuum  robot  shapes.  In  [27],  researchers  presented 
a  2-D  dynamic  model  for  the  octopus  arm.  However,  while  allowing  extensibility,  the  model  is 
based  on  an  approximation  (by  a  finite  number  of  linear  models)  to  the  true  continuum  case.  In 
[6],  Chirikjian  and  Burdick  considered  extensibility  of  hyper-redundant  manipulators.  A  kinematic 
model  was  presented  based  on  the  modal  approach  introduced  in  [7]  and  a  dynamic  model  was 
proposed  in  [5].  In  [11],  Ivanescu  et.  al  proposed  a  dynamic  model  for  an  extensible  tentacle  arm. 
However,  the  dynamic  model  proposed  in  [5]  for  3-D  case  remains  in  integral  differential  form,  which 
makes  it  problematic  for  real-time  control  and  the  dynamic  model  suggested  in  [11]  was  computed 
only  as  an  approximation  in  closed  form.  In  [19]  and  [20],  Mochiyama  and  Suzuki  presented  a 
three-dimensional  dynamic  model  for  an  inextensible  (constant  length)  continuum  manipulator. 
Mochiyama  and  Suzuki  considered  the  continuum  robot  as  a  combination  of  slices  where  each  slice 
is  considered  to  be  a  rigid  link.  To  derive  the  dynamic  model,  limit  of  a  serial  rigid  chain  model 
is  obtained  as  the  kinematic  degrees  of  freedom  goes  to  infinity.  However,  the  suggested  dynamic 
model  is  in  integral  form  and  also  does  not  include  extensible  manipulators. 

In  this  paper,  the  work  in  [19]  is  modified  and  extended  in  order  to  include  the  important  class 
of  extensible  continuum  robot  manipulators.  A  geometric  model  of  a  3-link  extensible  continuum 
robot  manipulator  with  a  circular  cross-section  is  considered  (see  Figure  2).  For  simplicity,  the 
geometric  model  is  assumed  to  have  no  torsional  effects.  After  presenting  the  system  model  and 
model  properties,  the  kinetic  energy  of  a  slice  of  the  continuum  robot  is  evaluated.  The  total  kinetic 
energy  of  the  manipulator  is  obtained  by  utilizing  a  limit  operation  (i.e.,  sum  of  the  kinetic  energy  of 
the  slices).  By  utilizing  a  Lagrange  representation,  the  dynamic  model  of  a  planar  3-link  extensible 
continuum  robot  manipulator  is  obtained.  It  is  also  proved  that  the  skew-symmetry  property  is 
satisfied  for  the  presented  dynamic  model  (i.e.,  ^ M  ( q )  —  2V  ( q ,  q)  j  is  skew-symmetric).  Numerical 
simulation  results  are  presented  for  a  planar  3-link  extensible  continuum  robot  manipulator. 

2  System  Model  and  Properties 

The  geometric  model  of  a  3-link  extensible  continuum  robot  manipulator  utilized  in  this  paper  is 
presented  in  Figure  2.  This  geometric  model  is  a  good  model  of  OCTARM,  a  soft  continuum  robot 
manipulator,  which  is  shown  in  Figure  1. 

The  following  convention,  which  is  adopted  from  [19],  will  be  adhered  throughout  the  following 
development.  The  matrix,  °$  (0)  G  SO  (3)  represents  the  orientation  matrix  of  the  base  frame,  and 
°p  (0)  G  M3  represents  the  position  vector  of  the  origin.  The  matrices,  °$  (a,  t )  ,  (a,  t )  G  SO  (3) 
represent  the  orientation  matrices  of  the  extended  Frenet  frame  at  o  relative  to  the  base  frame 
and  ^$(£,t)  G  SO  ( 3),  respectively.  The  vectors,  °p(a,t),  ^p(a,t)  G  M3  represent  the  position 
vectors  of  the  point  a  relative  to  the  origin  as  viewed  from  the  base  frame  and  Ah  (£.  respectively. 
For  simplicity,  the  notation  of  $  (cr,  t )  and  p  (cr,  t )  will  be  preferred  instead  of  (cr,  t)  and  ap  ( a ,  t ) 
throughout  the  rest  of  the  paper.  The  section  lengths  of  the  manipulator  are  denoted  as  d*  ( t )  G  R+, 
i  —  1,2,  3,  and  k  (cr,  f)  Gt  represents  the  curvature  of  the  point  cr.  The  total  length  of  the  robot 
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Figure  1:  Octarm  Continuum  Robot  (version  5.2)  in  Clemson  University  Mechatronics  Laboratory 

manipulator,  denoted  as  d  (t)  G  R+,  is  equal  to  the  following 

d  ( t )  =  di  ( t )  +  d2  (t)  +  d%  ( t ) .  (1) 

The  system  model  is  assumed  to  satisfy  the  following  properties. 

Property  1  The  curvature  k  of  each  point  a  of  the  manipulator  is  a  function  of  both  time  and  cr. 
Consistent  with  the  OCTARM,  it  is  assumed  that  the  curvature  of  a  link  is  only  function  of 
time  (i.e.,  n  (a,  t )  =  k*  ( t )  if  a  is  a  point  on  Link  i,  i  =  1,  2,  3).  It  is  assumed  in  the  analysis 
that  the  curvature  is  always  non-zero  (i.e.,  n(cr,t)  ^  0  V  (cr,£)). 

Property  2  In  Figure  2,  p  (£,  t)  G  R3  is  the  position  vector  of  point  £  of  the  backbone  curve  and 
pc  (£>  t )  G  R3  is  the  position  vector  of  the  center  of  mass  of  the  slice  at  £.  Again  consistent  with 
the  OCTARM,  it  is  assumed  that  p(£,t)  and  pc  (£,  t)  coincide  (i.e.,  A p(£)  =  [  0  0  0  ]T). 

Property  3  The  mass  density  of  the  robot  manipulator  is  uniform.  The  line  mass  density  of  the 
slice,  denoted  as  m  (a,  t )  G  R,  is  defined  as  follows 

/  x  m  /  x 

m(a't)  =  W)  () 

where  m  G  R  is  the  total  mass  of  the  manipulator. 

Property  4  Since  the  system  is  assumed  to  be  planar  with  no  torsional  effects,  then  the  system 
has  no  gravitational  potential  energy. 


3  Dynamic  Modelling 


The  orientation  matrix  of  the  extended  Frenet  frame  at  a  with  respect  to  the  base  frame,  denoted 
as  0<h  (cr,  t),  is  given  as  follows 


°$(M) 


cos  (are  (cr,  t))  0 
0  1 
sin  (crre  (cr,  £))  0 


—  sin  (cr k,  (cr,  t)) 

0 

cos  (an  (cr,  t)) 


(3) 


3 


d(t) 


Figure  2:  Geometry  of  a  3-Link  Extensible  Robot  Manipulator 
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The  orientation  matrix  given  in  (3)  is  equal  to  the  orientation  matrix  provided  in  Equation  (8)  of 
[13]  with  the  angle  of  curvature  is  equal  to  zero  (i.e.,  c )  =  0).  The  change  of  the  orientation 
matrix  along  the  manipulator  is  characterized  by  the  following  equation 


d  °$(<7,t) 


°$  (cr,  t )  ax  (cr,  t ) 


(4) 


where  ax  (cr,t)  G  M3x3  is  the  skew-symmetric  matrix  of  the  frame  rate  vector  a  (cr,t)  G  M3.  After 
utilizing  (3)  and  (4),  a  (cr,  t )  and  ax  (cr,  t )  can  be  defined  as  follows 


a  (cr,  t )  = 

0 

— K  (cr,  t ) 

,  ax(cr,f)  = 

0 

0 

0 

0 

1 

£ 

0 

K  (cr,  t ) 

0 

- 1 

0 

The  position  vector  of  the  point  cr  from  the  origin  p  (0)  with  respect  to  the  base  frame,  denoted  as 
°p  (cr,  t ),  is  evaluated  as  follows 

°P(M)  =  [  °®(v  ,t)exdr/  (6) 

Jo 

where  ex  =  [  1  0  0  ]T.  The  orientation  matrix  of  the  extended  Frenet  frame  at  cr  relative  to 
$  (£,  t ),  denoted  as  (cr,  t ),  is  calculated  as  follows 

S*(M)  =  °$T(e,t)  (7) 


The  position  vector  of  the  point  a  relative  to  the  origin  as  viewed  from  $  (£,  t).  denoted  as  ^ p  (a,  t ), 
is  evaluated  as  follows 


*P(M)  =  °4>T  (£,t)  °p(cr,t). 


(8) 


The  internal  variable  vector  at  a  which  is  denoted  as  9  (cr,  t)  G  M2  is  defined  as  follows 


9(a,t)  = 


K  (cr,  t ) 


(9) 


where  l  (cr,  t )  and  k  (cr,  t)  reflect  the  extension  and  curvature  of  the  model.  The  extended  axis  matrix 
A  ( 6  (cr,  t ))  G  M6x2  is  defined  as  follows 


A  (9(a,t))  = 


1  0  0  0  0  0 
0000-10 


(10) 


So  far,  the  main  extension  of  this  development  over  [19]  is  the  definition  of  the  internal  variable 
vector.  The  extensibility  of  our  model  is  reflected  by  designing  9(a,t)  to  include  This 

design  allows  the  model  to  extend  in  each  section,  which  results  in  a  variable  total  length,  while 
the  geometric  model  presented  in  [19]  had  a  constant  total  length.  As  a  consequence  of  this  new 
design  for  the  internal  variable  vector,  the  extended  axis  matrix  is  modified  accordingly.  The  adjoint 
matrix  Adg £  R6x6  in  terms  of  the  rigid  body  transformation  g  (a,p,t)  £  SE  (3)  is  defined  as 
follows 


Ad 


9A,V,t) 


CT<f>(?7,f)  (°px  (p,t)  ~  aPx  (aA))  CT4>(?7,f) 

03x3  CT4>(?7,f) 


(11) 
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where  03X3  G  M3x3  is  a  matrix  of  zeros.  The  kinetic  energy  of  the  slice  at  cr  (see  Figure  2)  is  given 
as  follows  [19] 


K  AT  (v,  t)  AdTg{(J^t)M  (a,  t )  Adg{aU)A  (£,  t)  —  %  —  dr)d£  (12) 


dt 


dt 


0  0 


where  M  (cr,  t )  G  M6x6  is  the  inertia  matrix  of  the  slice  at  a  which  is  defined  as  follows 


M  (cr,  t)  = 


m  (cr,  t)  I3  —m  (a,  t )  A px  (cr) 
m  (cr,  t)  Apx  (cr)  /  (cr) 


(13) 


where  m  (cr,  t)  A p  (cr)  G  M3  is  the  hrst  moment  of  inertia  of  the  slice,  I  (cr)  G  M3x3  is  the  inertia 
tensor  of  the  slice,  and  1 3  G  M3x3  is  the  standard  identity  matrix.  The  inertia  tensor  of  the  slice  is 
assumed  to  be  of  the  following  form 


mr 

2 J 


1  0  0 
0  0  0 
0  0  0 


(14) 


where  r  is  the  radius  of  the  circular  cross-section  of  the  robot  manipulator.  After  utilizing  Properties 
1  and  2,  the  inertia  matrix  of  the  slice  at  cr  can  be  evaluated  as  follows 

M(a,t)=diag{  f,f,f,y|p,0,0}.  (15) 

Due  to  the  piecewise  definition  of  the  curvature  (see  Property  1),  the  kinetic  energy  of  the  slice  at 
cr  which  is  formulated  by  (12)  will  not  be  evaluated  explicitly.  However,  by  sliding  the  slice  at  cr 
over  every  section  of  the  manipulator,  the  kinetic  energy  of  every  slice  at  cr  can  be  calculated.  The 
expression  in  (12)  can  be  rewritten  as  follows 

cr  cr 

K  (cr,t)  =  J  J  I  (cr,  77,  £,  t)  drjdi  (16) 

0  0 
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where  /  (cr,  rj,  £,  t )  is  the  integrand  defined  as  follows 

^  \i(£,t)i(rj,t)  cos  (£k  (£,  t) -rjK(rj,t)) 

1  1 


2d 

+i  (f ,  t)  k  (rj,  t ) 

1 


(17) 


K  (cr,  t) 


l\K(v,t)  K(a,t) 
cos  (£«(£,£)  -  an(a,t ))  - 

1  1 


cos  (f«(f,f)) 

1 


L\«(f»*)  «(<7,£) 


« ('7, 0 

cos  (r]K  (rj,  t)) 


cos  (£«(£,£)  -r)K  (■ rj,t )) 


+  /  .x  cos  (<rre  (cr,  f)  -  tjk  (rj,  t))  -  1  cos  (f  re  (f ,  f)  -  ijK  (rj,  t)) 


K  (cr,  f) 

+« (£,  *)  « (»7,  *) 
2 


1 


1 


+ 


«(£,*) 

l 


n(a,t)  \K,(£,t)  k  (rj,  t)  k  (cr,  t) 


cos  (an  (cr,  £)) 


+ 


1 


1 


1 


K2(cr,t)  «(£,£)  \n((T,t)  k  (rj,  t) 

(1  +  cos  (£re  (£,£)- crre(c7,f))) 


cos  (fre(f,t)) 


K(t,t)  k  (a,  t) 
1  1 
n  (rj,  t )  re  (cr,  £) 


(1  +  cos  (cr re  (a,  t )  —  rjK  (rj,  £))) 


+ 


1 


1 


1 


«(M)  VK(M)  K(£,t) 

The  total  kinetic  energy  of  the  system  is  defined  as  follows 

d(t) 

K  ( t )  =  [  K  (a,  t )  da 


cos  (rjK  ( rj,t )) 


(18) 


where  K  ( a,t )  is  the  kinetic  energy  of  the  slice  at  a.  The  upper  limit  of  the  integral  in  (18)  is  the 
total  length  of  the  manipulator,  which  is  a  function  of  time  as  a  result  of  the  extensible  nature  of  our 
geometric  model.  However,  the  total  length  of  the  manipulator  in  [19]  was  constant.  To  facilitate 
the  subsequent  development,  the  total  kinetic  energy  of  the  system  will  be  rewritten  as  follows 


di(t)  d2(t)  d3(t) 

K  ( t )  =  j  K\  (a,  t)  da  +  J  K2  (a,  t)  da  +  J  K3  (a,  t )  da 

0  di(t)  d2(t) 


(19) 


where  Ki  (a,  t)  is  the  kinetic  energy  of  slice  a  when  a  is  a  point  on  Link  i,  i  =  1,  2, 3.  To  facilitate 
the  subsequent  development  1^  (a,  rj,  £,  t)  is  defined  as  follows 

Iijk(a,rj,i,t)  =  I  (v,rj,t,t)l  eUnkij1]  eLinkj£  eLinkk  (20) 

where  for  any  s  G  Link  i  means  l  (s)  =  ci?:  (t)  and  re  (s)  =  Kt  ( t ).  After  utilizing  (16),  (19),  (20)  along 
with  Property  1,  Kt  (a,  t),  i  =  1,  2,  3  can  be  evaluated  as  follows 

a  a 

Ki  =  J  J  /in  (a,  7j,  i,  t )  dijd£  (21) 

o  o 
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d\(t)  d\(t) 


K2  (a  ,t]-  f  j  hn  (a,  Vi  Cd)  d'Tjd^  +  J"  j  I221  (<T  Vi  Ci 1)  dvdC, 

0  0  0  di(t) 

a  d\(t)  a  a 

+  J  j  I212  {cr,V,i,t)dvdi  +  J  J  I222  (cr,v,^,t)dvd^  (22) 

d\{t)  0  d\(t)  d\{t) 

di(t)di(t)  di(t)d2(t) 

K3(a  ,t)  -  j  j  h ViCd)  dvd£  +  J  J  I321  (<T  Vi  £1 1)  drjd^ 


0  0 

d\  ( t )  a 


+ 


I331  (cr,  Vi  €,  t )  d;qd£  + 


J  J 

0  d\  (t) 

d2[t)  di(t) 
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+ 
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d2{t) 
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(23) 


To 


I333  (cr,  7 /,  £,  t)  dr]d£. 

J  J 

d2(t)  d2(t) 

facilitate  the  subsequent  development  the  joint  position  vector  q  (t)  G  M6  is  defined  as  follows 

q  =  [  di  d2  d3  ki  k2  k3  ] T  ■ 
the  total  energy  of  the  system  can  be  evaluated  as  follows 

+  Kdik3dxkz 


(24) 


K 


(17),  (19)-(23), 

kld\Ki  + 

2 


After  utilizing 

(t)  =  KcMdi  (di)  +  K^did2  +  Kj^dids  +  K^ki 

+Kd2d2  (^2)  +  K^3d2d3  +  K^kld2k  1  +  K^2k2d2k2  +  K^k3d2k3  +  TQ31.j3 

+7^3^^  +  K^k2d3k2  +  K^k3d3k3  +  K^ki  («u)2  +  Kkik2Kik2  +  Kkik3k\k3 

+Kk2k 2  (^2)2  +  +  ^k3k3  (^3) 

In  (25),  Kq^  with  g*  and  q3  being  entries  of  q  (t),  are 


3k2k3  +  Kk3k3  i, 

:  defined  in  Appendix  A. 


4  Lagrangian  Representation 


The  Lagrangian  of  the  system  is  defined  as  follows 


£  W  =  (0 


(26) 


where  Property  4  was  utilized.  Euler- Lagrange  equations  of  motion  are  defined  as  follows  [23] 


_  dL  _ 

7,0-  <-)  T~i  i  1  j  2  j  •  •  •  ,  6 . 

at  oqi  oqi 

After  utilizing  (27),  the  dynamic  model  of  the  system  is  developed  as  follows 

M  ( q )  q  +  V  (q,  q)  q  =  r  (t) 


(27) 


(28) 


where  M  (q),  V  fiq,  q)  G  M6x6  are  the  inertia  matrix  and  centripetal-coriolis  terms,  respectively,  and 
t  (■ t )  G  M6  is  the  control  input.  The  inertia  matrix  M  ( q )  and  the  centripetal-coriolis  terms  V  ( q ,  q) 
are  defined  as  follows 


M{q)± 


^did.2 
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K 

K 

IVd2k3 

K: 
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K d3k2 

K  ■ 
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^I'-K2K2 
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K d2k3 
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(29) 


V  (q,  q)  = 


Vu 

V21 

V31 

V41 

Vu 

V(il 


V12 

V22 

V32 

V42 

V52 

V62 


V13 

v23 

V33 

V43 

V53 

VG3 


Vu 

V24 

v34 

V44 

Vb4 

VG4 


V15 

v25 

V35 

V45 

V55 

V65 


Vie 

v26 

V36 

V46 

V56 

V66 


(30) 


where  the  entries  of  the  inertia  matrix  and  centripetal-coriolis  terms  are  defined  in  Appendices  A 
and  B,  respectively. 

Remark  1  The  inertia  matrix  M  (q)  and  the  centripetal  coriolis  terms  V  (q,  q)  defined  in  (29)  and 
(30)  with  entries  defined  in  Appendices  A  and  B  satisfy  the  following  property: 


?{M- 2V'U  =  0,  V£e 


(31) 


When,  the  matrix  yM  —  2 VJ  is  skew-symmetric,  then  (31)  is  satisfied.  The  proof  of  [M  —  2V 
being  skew-symmetric  is  provided  in  Appendix  C. 


5  Numerical  Results 

To  underline  the  validity  of  the  proposed  dynamic  model,  two  numerical  simulations  are  presented. 
In  both  simulations,  the  model  presented  in  (28)- (30)  is  utilized.  The  model  is  implemented  in 
Matlab  7.0.  In  the  first  simulation,  to  illustrate  the  extensibility  in  the  model,  the  system  is  fed 
with  r3  it)  being  a  step  function  with  an  amplitude  of  10-4  [ Nm ]  for  a  duration  of  5  seconds,  while 
the  other  entries  of  r  fit)  are  set  to  zero.  While  the  changes  in  the  curvatures  are  negligible,  the 
section  lengths  are  presented  in  Figure  3.  From  Figure  3,  it  is  clear  that  the  third  section  extends 
appropriately  as  expected.  In  the  second  simulation,  to  illustrate  both  bending  and  extending 
capabilities  as  well  as  the  dynamic  behaviour  of  the  model,  the  system  is  fed  with  the  control  input 
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Figure  3:  The  section  lengths  for  the  first  simulation 


presented  in  Figures  4  and  5.  From  Figure  6,  it  can  easily  be  seen  that  the  third  section  is  extended, 
and  from  Figure  7,  it  is  clear  how  the  third  section  is  bent.  The  changes  in  <l> ,  n\  and  illustrate  the 
results  of  the  dynamic  input  and  coupling  between  the  sections.  However,  it  should  be  noted  that 
the  movements  observed  in  K\  and  Ko  are  negligible  (i.e.,  the  radii  of  curvature  are  approximately 
10  [to]  for  both  cases).  Aside  from  the  presented  results,  also  the  dynamic  model  is  observed  for 
commonly  used  properties  in  the  performed  simulations.  In  both  cases,  the  dynamic  model  satisfied 
the  skew-symmetry  property,  and  the  inertia  matrix  always  has  a  positive  determinant  as  expected. 

6  Conclusions 

A  novel  dynamic  model  for  planar  extensible  continuum  robot  manipulators  was  derived.  First,  the 
kinetic  energy  of  a  slice  of  the  continuum  robot  was  evaluated.  Then,  the  total  kinetic  energy  of  the 
manipulator  was  obtained  by  utilizing  a  limit  operation  (i.e.,  sum  of  the  kinetic  energy  of  all  the 
slices).  Finally,  the  dynamic  model  of  a  planar  3- link  extensible  continuum  robot  manipulator  was 
derived,  by  utilizing  the  Lagrange  representation.  Numerical  simulation  results  were  presented. 
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Appendices 


A  The  Entries  of  the  Inertia  Matrix 

The  entries  of  the  inertia  matrix  are  defined  as  follows1 
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1  The  calculation  of  the  these  terms  was  done  by  MAPLE  9.5. 
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The  time-varying  functions  r,  (t) ,  i  =  1,  ...,26,  in  (32)-(52)  are  introduced  to  simplify  the  calcula¬ 
tions.  They  are  defined  as  follows 
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r6  =  —  [cos  ((di  +  d2)  k2  —  dn3)  —  cos  (di«2  —  d/c3)] 

(58) 

k2 


7"7  —  1  —  COS  (d3K3) 


1 


r8  =  — ~2  [sin  (di/c2)  -  sin  ((di  +  d2)  «d)] 


(59) 

(60) 


r9  —  —j  [sin  (<ft  (Ki  -  K2))  -  sin  (diKi  -  (di  +  d2)  ^2)] 

/^i^2 


(61) 


rio  = - 2  (s^n  (^iKi  —  (di  +  d2)  k3)  —  sin  {d\K\  —  d/c3)] 

KlK3 


(62) 


rn  =  - 2  [sin  (di/^2  —  (di  +  d2)  k3)  —  sin  (di«2  —  dhi3) 

Kj2  ^3 

+  sin  ((<•/,  +  d2)  k2  -  efc3)  -  sin  (r/ ,  +  d2)  (k2  -  «3)] 


(63) 
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r12  =  ~2  [sin  ((di  +  d2)  k3)  -  sin  (d/c3)] 

KjO 


r  13  =  ~2  [COS  (^1^2)  -  COS  ((di  +  d2)  k2)\ 

Kj  9 


ri4  =  [cos  ((^1  +  d2)  K-i)  ~  cos  (^3)] 

Kj  O 


r15  =  — 2— j  [cos  (di/ci  —  (di  +  d2)  /c3)  +  cos  (di/ci  —  d/c3)] 

k1k3 


f  16  = - 2  tsin  ((^i  +  ^2)  «3)  -  sin  (d/c3)] 

K1K3 


r17  =  [cos  ((di  +  d2)  /c2  -  di/ci)  -  cos  (di  (k2  -  /ci))] 

kik2 


r18  =  [cos  (d/c3)  +  cos  ((di  +  d2)  /c3)] 


k2k2 
K  1k3 


t  19  =  ~2  [sin  (d/c3)  +  sin  ((di  +  d2)  /c3)] 


/CS 


r2o  —  —  (d2  +  d3)  cos  (di/Ci)  +  di  +  d2  +  d3 - sin  (d^Ki) 


r2i  =  — d3  cos  ( d2K2 )  +  d2  +  d3 - —  sin  (d2K2) 

k2 


r22  =  d3  -  —  sin  (d3/c3) 
^3 


d3 

r23  = - [cos  ((di  +  d2)  /c2)  -  cos  (di/ci  -  (di  +  d2)  /c2)] 

KiK2 


r24  —  +  [cos  (di  (/ci  -  /c2))  -  cos  (di/c2)] 

K\K2 


r25  —  '  [cos  (diKi  -  (di  +  d2)  H3)  -  cos  ( (di  +  d2)  K.tj] 

K1K3 


d3 

r26  — - [cos  (difv2  -  (di  +  d,)  k3)  -  cos  (di  +  d2)  (k2  -  k3)[ 


(64) 

(66) 

(66) 

(67) 

(68) 

(69) 

(70) 

(71) 

(72) 

(73) 

(74) 

(75) 

(76) 

(77) 

(78) 
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B  The  Entries  of  the  Centripetal- Coriolis  Matrix 


The  elements  of  the  centripetal-coriolis  matrix  V  ( q ,  q)  are  dehned  as  follows 

-Ki 


Vu  ± 


dKdldl  ■  ,  dKdidi  dKdidi  dKdidi  . 

■di  H - xt —d2  H - xr — d3  +  " 


ddi 


dd2 


ddi 


dni 


Vl2  = 


dK. 


d\d2  j 


dd2 
dK : 


dKd  J  .  dKd  ;  .  did ;  ,  . 
d2  -  -x^d2  +  -x4^di  +  -x^d. 


d/ci 


-Ki  + 


ddi 

did 


dd2 


dd3 


dK 


did2  •  d^d2k\  ■  ^^d2k2  • 

^2 - XT K1 - XT ^2 


ddi 


ddi 


(79) 

(80) 


Vis  = 


dd3  ddi 

did,  ;  .  did 
-  d2d3d2  + 


did3 


ddi 


d^i 


Kl  + 


dd3 

did 


dd2 


dK 


oilT  •  ^^d3k  1  •  ^^d3k2  ■ 

K3 - XI - M - XT ^2 


ddi 


ddi 


(81) 


hi  4  = 


did. 


dKi 


« i 


^idAlAl 


did. 


dd 


dlAl  d3  + 


ddi 

did,,. 


Kl  + 


dKi 


dK 


d/d- 

<*l«l  ^2  -)_  “l«l 


dK3 


dd2 
dKk  iAg  . 

K3 - XT - K3 

<7£X;l 


(82) 


hh5  ^ 


did 


dl«2 


dK2 

did. 


k2  - 


k2  H — ^ — a2  H — — — a3 


d\k2 


dn\ 


Kl  + 


ddi 

did. 


dd2 


dd3 


dK 


d\k2  •  did^1K2  .  did^2re 3  . 

K3 - XX - K1  XT - k3 


ddi 


ddi 


(83) 


_  dKdlk3  dKksk3  . 

16  —  — x - K3 - XT ^3  X 


V>6  = 


dK3 


ddi 


,  dKdlk3- 

«2  i - XT - «3  H - X - «h  — 


dd- 


dd3 


dKi 


dKd2k3  d2  -  ^4^d3  (84) 


ddi 


ddi 


F2i  = 


did; 


ddi 


Ldi 


dd2 


ddi 


ddi 


Kl  + 


did. 


c*2«;2 


ddi 


k2 


(85) 


.  dKi ,)  ■  dKi  ,  .  dKi  j  .  dK 

T  r  A  d2d2  j  ,  a2a2  J  I  a2«2  j  . 
r22  —  — — — «i  H xi — a2  H xi — «3  + 


ddi 


dd2 


dd3 


dK- 


didi  • 

K  2 


^23  = 


did. 


dd; 


d2d3d3 


^3+^2+^1+^ 


dK. 


did3 


dd2 


dd3 


dd3 


ddi 


dd2 


di 


^3-  3 

■k2 


dK2 


dK3 


,  ^  ^*3, 

k3 - XT - XT — ^2 - XT — k3 


dd2 


dd2 


dd2 


(86) 

(87) 


^>4  = 


-Ki  — 


dKi 

dKd2kl 

dK3 


8Kklkl  dKd2ki  .  dKd2ki 

M  H - XT — “3  H - X - h2 


7)3  + 


dd2 

did 


dKi 


di 


dd3 

TwTdl 


0k2 
dKklk2 


dd2 


-k2 


(88) 
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Y  A  dKd2k2  ■ 

*25  ~  — ^ - ^2  — 

9k2 


dK-K2k,2 

dd2 


K  2  + 


dKd2d2,  dKd2k  dKd2k2 

«2  H - — - «3  H - ~ + 


9k2 


dd-\ 


9k2 


9K;  d  .  dK;  .  . 

dld2di - ^dx  (89) 


9k2 


dd2 


V26  4 


®Kd2k3  ■  8Kk 3K3 

^3 - 7Ti ^3  + 


5k 


ddo 


dK 


5<9i 


5(9,2 


a**,*,.  aifj,*,;  ax*,*,.  ax*,*,. 

H - ^ - ^2 - - “1 - Y~, - M - 7Y, - K2 


9k2 


dd2 


dd2 


dd2 


(90) 


^31  = 


dK^d1  -  <±dl  +  9Kd3d3  j 


ddi 


dd2 


ddi 


dK;  :  . 

C/Ctl 


d  ,  5*«fe*x 


A  ,^2. 
i - ^ — 1^2 

od\ 


(91) 


^32  = 


OK,  ,  .  dK;  ,  .  5 A',  ,  .  9 AT;  j  . 

d2d3-  d2 - +  -^d3  + 


5<92  "  5d3 

9K;  ;  .  5A.;  , 

dld2^  + 


5<92 


5<92 


5  <9.2 


5c9 


d3Ki  •  .  ^^d3k,2  •  ,  ^^d3k3  ■ 

—  «1  H - 777^2  H - 7TY^K3 


dd2 


dd2 


(92) 


A  3K;  ;  .  dK)  ;  .  dK;  ;  .  dK;  ; 
VrA  =  —^d1  +  7Y7~^~d2  +  TYT-^ds  +  - ^ 


(9  c?! 


5<92 


dd-A 


9ka 


k3 


(93) 


i/  a9a4«,a  ax*.* 

^34  —  — o - M 


,ll61  (9 A;  ,  (9 A;  ;  .  <9ATj  •  .  (9 A;  , 

«1K1  .  ,  Q3K1  •  ,  did3  J  djh,!  J  d2Ki  j 

- ^3  H - o - “1 - — - “1 - - - «2 


(9«i 


dd-A 


-K 1  + 


5k3 


5«)i 


ddA 


dd* 


dK-  ■ 

-^P«  2  (94) 

ud'i 


y  A  ®Kd3k2  ■  9Kk2k2  dKdak2 
*35  ~  — ^ - ^2 - 7Y - k2  H - ^ 


5k2 


dd-A 


9ka 


dK;  •  .  (9 A;  ;  . 

1  2-d\  +  J2d3d2 


ddi 


9k2 


9Kd2k2- 

~ddTd2 


(^) 


^36  = 


dKd3it3  ■  dKk3ks 

K3 - 7Y - ^3  + 


dK 

dK 


dd2 


dK;  ;  .  dK;  .  . 

d3d36?3  + 


(9k,-( 


d\d3 


9ka 


d\ 


dd2 


9ka 


ddi 

^32 

2 


dKklk3 
dd?, 


-k  1 


(96) 


T,  a  j  dKd  d  -  t  dKklkl  .  ,  afrAlAs 

V4i  =  — d\ - - - di  H - — — «i  + 


(9rii 


(9«i 


<9o?i 


(9o?i 


«3 


(97) 


t a  A  ;  ,  dKklkl 

*42  ~  — - «2  H  7TT - ^1 

C/6i2  ud2 


dKd'd2dl  + 


9  k  i 


<9^2 


ddi 


dd2 


k2 


(98) 


K,3  A 


a*iA, ;  ^  a^M 

■«3  I 


ddA 


ddA 


K  i 


9a«A  +  ^ 


(9ki 


5(92 


,  g^x^  |  ^3*1  ; 


5(9.2 


ddi 


7  .  ^  ^  -  A1A2  • 

dd,  d2  +  ~ddTK2 


(99) 
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T  r  A  j  ,  dKk  1K1  j  dK^fn  j  dK^1k\ 

ViA  —  - — - CEi  H - 777 - CL 2  H - 777 - «3  + 


ddi 


dd2 


dd. 


<9k  i 


.  ,  3*rAlAl .  ,  dKki 

k\ 

K 1  H - 7 - ^2  + 


<9k2 


<9k,-j 


«3 


(100) 


t  t  a  dKklk2  .  dKklkl  .  dKklk2  . 

O5  =  “77 - H - 74 - «1  H - 7) - ^3  + 


<9k2 


<9k2 


<9k  o 


-  dI^di  +  (ioi) 


ddi 


<9k2 


<9ki 


<9k2 


(9R'-  • 

T7-  A  ty-fV«1^3 

VAfi  — 


.  3/4lAl. 

%  H - 7) - « 1  + 


+ 


<9k3  <9k3 

3/0  :  <9/0., 


^1/^1 


<9k3 

OK; 


d\  — 


^1«3  J 


(9ki 


c?l  + 


dKklK3  j  dKklk_3  • 

“mt^2 + “Mrd: 

9K.>.  ■  dKjskl  , 


<9k 


^  d2  + 


<9k3 


;)/v-  .  ;)/v  ■  .  <9/7.  . 

T  /■  ^  ai/^2  J  I  •  ,  (VJVK1/C2  •  ,  W1^K2K2>  • 

0,1  =  0  ,  O  +  —777 - K2  +  —777 - Ki  +  — — - K3 


ddi 


ddi 


ddi 


ddi 


(102) 


(103) 


t  /"  A  ^^d2k2  j  ^^d2d2  j  .  9  K fa  fa 
V/52  —  - 777 - «2 - - - tt2  + 


<9/2 


03  = 


<9k2 

dK i  , 


dd2 
dK AoA 


.  a/o^2j  , 

« 2  — +  A  A  +  A  ~d\ 


d3k2  <jj  ^-1'-K2K2 


+ 


<9/3 

azo , 


<9<A 


k2  + 


<9k2 


<9Z2 

dK, 


ddi 


^do 


dd: 


dK,. .  dK,,.,, 

■-di  + 


d2"2  r/2  +  — A0/1  +  + 


<9k2 
A,, 


5/1 


<9Z2 


(9rl 


• 

^3 


(104) 


(105) 


_a_  dKk,k2  .  dKklkl 

O4  —  — 7 - fti - 7 - 


(9ki 


<9k2 


+  ^0^0  -  ^a2  +  ^AA2  +  (106) 


<9k2 


<9ki 


<9k2 


dd2 


ddt 


dK-  ■  ■  dK ■  ■  .  dK-  ■  ■  dK-  ■ 

T  r  A_  U1VK2 K2  ,  U1'-K2K2  r  U1'-K2K2  ,  ,  U1'-Ks>K 

V55  —  - 777 - al  H  777 - “2  H - 777 - “3  + 


x56 


- ; 

90 

-di  H — 

- 

C>/2 

■d2  H — 

- 

dd-3 

A 

dKk2k3 

'O  + 

9Kk2k,2 

■k2  + 

“ 

dn3 

dn3 

<9k 


dK-  ■ 

K1K2ki  + 


dK-  ■ 

K2K2  •  1  U1YK2K2 

k2  + 


<9k  7 


(9k,-i 


dK-  ■  ■ 


K3 


dd2 


+^^di  +  ^^ci2  ~  ^^ri2  + 


(9k,7 


(9k,3 


<9k2 


(9k,o 


(107) 

(108) 


Vs,  = 


A  dKd,k,i  3Kk,k  3Kdlk.  dKdakt 


ddi 


-di  + 


1  “a»»3  ^  1  a3(«3  j 

dd,  K3  +  ~mT  2  +  ~mT  3 


(109) 


T/  A  ^^d2k3  j  dKk3k3 
»  62  —  — 777 - a2  4 - 777 


dd2 


dd2 


K3  + 


^*3.^  +  ^*1*3 


dd2 


dd2 


d-k-k2k,3  . 

« 1  H - 7T7 - «2 

udo 


(110) 


.  dK, .  .  ail, 

T4  A  “3K3  J 

03  —  — 777 - “3  — 


<9/3 

9/v 


dK- 

«3  H - 777 - ^3  — 


j 


dd2 


di 


dn3  dd3 

dK,  :  .  o9A', 

«2«3  I 

— ^ - ^2  + 

OK?. 


d2^3  j 


dd3 


d2  + 


<9k3 

a  a:. 


dld30 


5/' 


d3,i;3  ^*3 


(9ri.-j 


Ki 


(111) 
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r)K  ■ 

T  r  A  KJ1'-K\K3  . 

m34  —  — X - K 1  — 

C/ACi 


gggifa 

<9k3 


-K 1  - 


+  _  ^Ai  ^  _  ^jAi  ^  +  ^A* 


<9k3 


<9ki 


(9k  3 


<9k3 


ddi 


<h  (112) 


^65  = 


dKfi 2 A3  .  9K^2k 2  .  dK^  1  h'2  . 

- ^2 - 7 - - 7 - Kl 


<9k 


<9k3 


- O - ^1 

OKz 


9Kd2k2-d2  +  ^ 


<9k3 


<9k2 


<9k3 

^^d3 A2  J  1  ^  Jp.  d^h2k3  ^ 


<9k3  <9o?i 


<9d3 


(113) 


r)K •  •  .  dK-  ■  ■  F)K ■  ■  .  /}/<'.  • 

TX  A  UlyK3K3  ,  U1^K3K3  ,  U1'-K3K3,  UlyH3K3  . 

'66  =  “T77 - “1  9 - 777 - “2  9 - 777 - “3  9 - 7 - K3- 


ddi  dd2  dd3  <9k3 

The  proof  for  the  skew-symmetry  property  is  presented  in  the  next  Appendix. 


(114) 


C  Skew- Symmetry  Property 

For  (m~  2v']  to  be  skew-symmetric,  the  following  should  be  satisfied 


M-2V)  +  (M-2V)  =0 


'6x6 


where  06x6  G 
obtained 


3x6 


(115) 


is  a  matrix  of  zeros.  Since  the  inertia  matrix  is  symmetric,  the  following  can  be 


M  =  V  +  V1 


(116) 


where  (115)  is  utilized.  From  (116),  for  yM  —  2V J  to  be  skew-symmetric  the  following  conditions 
for  diagonal  and  off-diagonal  elements  should  be  satisfied 


Mu  =  2Vn  ,  i  =  1, ...,  6 

Mji  =  Vij  +  Vji  ,  j  =  1, ...,  (i  -  1) . 

The  time  derivatives  of  the  diagonal  entries  of  the  inertia  matrix  are  given  as  follows 


Mu  =  2 


dK 


d\di  j 


ddi 


d\  + 


dK 


didi  ; 


ddo 


d2  + 


dK 


didi  j 


dd> 


d3  + 


dK 


d\d\ 


dK  1 


Ki 


(117) 

(118) 


(119) 


M22  —  2 


dK 


^2^2 


ddi 


d\  + 


dK 


^2^2 


ddn 


d2  + 


dK 


<^2^2 


dd3 


d3  + 


dK 


<^2^2 


<9k2 


«2 


(120) 


Af„  =  2  I  ‘K$kd1  +  +  dKh,):,  +  9Ri> 


ddi 


dd2 


dd3 


9k3 


K3 


(121) 


.  dKt- ,  K .  ■  dKf. , ,  ;  dKt; .  :■ ,  •  <9 AT,  2 

/f  r)  I  rvl  rvl  7  i  '*'1  '*'1  7  i  •'T  *vl  7  i 

lViAA  —  ^  I  — — ai  H - — - <22  H - — - $3 


dd3 


dd2 


dd3 


(9  k  i 


dKfc ,  dKfc  1(^1 

fin  H - - - k2  + 


<9k2 


5k3 


«3 


(122) 
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'BK-  ■  ■  BK ■  ■  ■  BK  -  ■  BK ■  ■ 

M,,  =  2  (  A^dx  +  A^d2  +  A^dz  +  K2K2 


Bdi 


dd2 


dd2 


9k2 


K2  + 


dKk2k2  . 

8k,, 


(123) 


Mqq  —  2 


(J  17*. ,  *  ,  ;  BKx.rtk.r,  9  I\  K-  ,  ,  ;  BKk.rtk 


ddi 


d\  + 


lK3K3 


9/2 


d2  + 


lK3K3 


9<7.3 


<73  + 


lK3K3 


9k,3 


-«3  • 


(124) 


After  comparing  (119)-(124)  with  (79),  (86),  (93),  (100),  (107),  and  (114),  it  is  clear  that  (117)  is 
satisfied.  The  time  derivatives  of  the  off-diagonal  entries  of  the  inertia  matrix  are  given  as  follows 


71 V  ^^d\d2  1  ,  ^^d\d2  l  ,  ^^d\d2  j  ,  ^^d\d2  ■  ,  ^^d\d2  ■ 

Mi2  =  xxx — d  1  H - — — d2  H - xx — «3  H - x - « l  H - x; - «2 


9<74 


9d2 


9(7,3 


9k  i 


9k2 


(125) 


Mis  — 


BK. 


d\d3 


dd  i 


di  + 


9/7 


^3  >  ^ 


9d' 


dids  j  | 

“2  H - XX - «3 


9/7; 


9(7,3 


a  I  --dids/.  |  d\dz  ■ 
“3  H  x - K  H  x; - k3 


9k  i 


9k,3 


(126) 


A/14  — 


9/7;  ,  .  9/7 ;  ,  .  9/7 ;  ■  .  9/7  ;  -  9/7;  ,  9/7;  , 


LC?i/7i 


dd\ 


di  +  ~~^d2  +  + 


Lc?l/€l 


9<72 


9(73 


9ki 


dl«!  .3  ,  W^d!ki  ...  ,  ““diKi  ... 

M  n - x - ^2  i - x - ^3 


9k2 


9K  3 


(127) 


Mis  = 


9/7 ;  ,  .  9/7 ,  ,  .  9/7 ;  ,  .  9/7;  ,  9/7, 


di/72 


dd\ 


di  +  ~-r^d2  +  + 


di«2 


9/7  j  . 


9<72 


9/3 


9ki 


diK2,-.  ,  ^“diKa  ...  ,  w±vd1k2.^ 

M  H  x; - ^2  i  x; - ^3 


9k2 


9K  3 


(128) 


Ml6  — 


9/7,;. ... ,  .  9/7;  .  9/7,  .....  .  9/7=  9/7;, 


Ld1K3 


9c?! 


<7i  + 


Ldi«3 


9<72 


d2  + 


di«3 


9/3 


<73  + 


L<^l/73 


9k4 


Ki  + 


LdiK3 


9K3 


^3 


(129) 


71/23  — 


9/7, 


d2d3 


9(7 1 


di  + 


9/7, 


d2ds 


dd2 


d2  + 


9/7, 


d2d3 


9/7; 


9/7; 


9(7,3 


A  I  d2d3  •  d2d3  • 

«3  H - x - ^2  H - x - ^3 


9k2 


9k.3 


(130) 


«2  H - xi — «3  H - x - Kfi  + 


M24  =  ^^d1  + 

od\  odj^ 


9(7,3 


9ki 


9k2 


-k2  + 


9ko 


(131) 


Kfej  ,  »«,;  .  S^a,  »  ,  S^Aa,.  .  ^a2 

«2  H - XX - «3  H - X - ^2  + 


7k/25  =  ^J^rfl+  0  7 

(7(2^  ud  2 


9/3 


9k2 


9k2 


(132) 


71/26  — 


9/7,;, .  ;  9/7;  :  9/7;  :  9/7;  9/7;  , 


«2/73 


dd\ 


d\  + 


9d 


d2K3^2  +  _^3d3  + 


9/3 


9k 


d2K3  i%  ,  d2K3  ... 

^2  H  x; - ^3 


9k2 


(133) 


7I/34  — 


9Kte>  A  ,  ^  ;  ,  dK^  ;  ,  , 

■«i  H - XX — “2  H - XX — “3  H - x - ^1  H - x - « 3 


3d, 


dd2 


9/3 


9ki 


9K3 


(134) 


71/35  = 


+  +  ^  =  dK^~ 


9<7i 


9d2 


9(7,3 


A  I  ■  d3K2  •  ,  ^J-yd3k2 

«3  H - x - ^2  H - x; - ^3 


9k2 


9k,3 


(135) 
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(136) 


•  dKk •  dKk,k 
M46  =  -^di  +  — ^ 
od\  ud2 


•  •  •  d K  •  •  dK-  ■  dK •  • 

- «2  H - W1 “3  H - o - K 1  H o - 1 

odz 


(138) 


AAfi  — 


;)/p.  .  .  dK-  ■  ■  dK-  ■  ■  dK-  ■ 

Uli-K 2«3  j  .  U1'-K2K3  i  ulyK2K3  j  Uli-K 2«3 

— oj — - oj — d2  “I - oj — H - t; - ' 

C/CiX  C/C62  C/tt3  <7/^2 


(139) 


After  comparing  (125)-(139)  with  the  corresponding  entries  of  id  (g,  g),  then  it  is  clear  that  (118)  is 
satisfied. 
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